http://vestnik-donstu.ru 


346 


Advanced Engineering Research 2022. V. 22, no. 4. P. 346-352. ISSN 2687-1653 


MACHINE BUILDING AND MACHINE SCIENCE 


® Check for updates 
BY 


UDC 621.865.8(075) Original article 
https://doi.org/10.23947/2687-1653-2022-22-4-346-352 : 


Calculation of Angular Coordinates for the Control System of 
a Two-Link Industrial Robot Manipulator 


Sergey P. Glushko © 
Kuban State Technological University, 2, Moskovskaya St., Krasnodar, Russian Federation 
sputnik_s7@mail.ru 


Abstract 

Introduction. One of the tasks of two-link manipulators of industrial robots that move the end-effector along complex 
trajectories (e.g., robot welder) is associated with the need for careful programming of their movement. For these 
purposes, manual programming methods or training methods are used. These methods are quite labor-intensive, and 
they require highly qualified service personnel. A possible solution to the problem of programming the manipulator 
movements is the simulation of motion with the calculation of angular coordinates. This can help simplify the geometric 
adaptation of the manipulator in the process of debugging the control program. Therefore, this work aimed at 
calculating coordinates for programming the control system of a two-link manipulator operating in an angular 
coordinate system and moving the end-effector along a complex trajectory (e.g., when welding car bodies). 

Materials and Methods. A two-link robot manipulator designed for cyclically repeating actions in an angular 
coordinate system was considered. The manipulator consisted of two rotating links: “arm” and “elbow”, which were 
fixed on the base. The base could rotate, which provided a third degree of freedom. This configuration increased the 
working area of the manipulator and minimized the area for its placement in production. The movement of the 
manipulator end-effector could be performed if the kinematics provided its positioning along three Cartesian and three 
angular coordinates. For software control of robots, including welding robots operating in an angular coordinate system 
and performing the movement of the end-effector along a complex trajectory, it was required to calculate the angular 
coordinates of the movement of the end-effector of a two-link articulated manipulator. The robot control system should 
determine the position of the tool in the angular coordinate system, converting it for user friendliness into x, y and z 
coordinates of the Cartesian coordinate system. 

Results. The relations of angular and Cartesian coordinates have been obtained. They can be used for calculating when 
programming the control system of a two-link manipulator of an industrial robot and organizing the exchange of 
information between the user and the control system, as well as for checking the accuracy and debugging the movement 
of the end-effector of an industrial robot through feedback. 

Discussion and Conclusion. The presented results can be used for software control of a welding robot operating in an 
angular coordinate system and performing a complex trajectory of the end-effector of a two-link articulated manipulator 
(gripper). A manipulator operating in an angular coordinate system can be used for contact spot welding when moving 
the end-effector along a complex trajectory using a positioning or contouring control system. These systems control the 
movement of the end-effector along a given trajectory with the help of technological commands. 
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Introduction. Industrial robots are used for automated control of the spatial orientation of tools and labor objects in 
various manufacturing processes! [1-7]. An industrial robot, as a rule, includes a manipulator having several degrees of 
mobility, and a drive numerical control device. The manipulator is used to move a gripper or a tool along a given 
trajectory to specified points in the technological space” [1-3]. 

When developing programs for controlling the movements of a gripper or an industrial robot tool along complex 
trajectories (e.g., for welding robots), training methods that are complex in organization and technical equipment are 
used. 

To simplify the programming of the control system of a two-link manipulator of an industrial robot that moves the 
end-effector along a complex trajectory (e.g., when welding car bodies), you can use modeling of its movements with 
the calculation of angular coordinates. This will simplify the geometric adaptation of the manipulator and the process of 
developing and debugging its control programs. 

The study is aimed at calculating angular coordinates for programming the operation of the control system for a two- 
link manipulator, which functions in an angular coordinate system and moves the end-effector along a complex 
trajectory. 

Materials and Methods. In practice, four main types of manipulators, which operate in cylindrical, spherical, 
rectangular or angular coordinate systems, are used. 

Figure 1 shows the working zone of the robot manipulator operating in an angular coordinate system. The 
manipulator consists of two rotating links — “shoulder” and “elbow”, which are fixed on the base. The base can rotate, 
which provides the third degree of freedom. This configuration increases the working zone of the manipulator and 
minimizes the area for its placement in production. 

A manipulator operating in an angular coordinate system can be used for contact spot welding when moving the 
burner along a complex trajectory. To perform contact spot welding, robots with a positioning or contouring control 
system are most often used. These systems control the movement of the burner along a given trajectory at a specified 


orientation at a constant speed using technological commands. 


Fig. 1. Working zone of a manipulator operating in an angular coordinate system (the author's figure) 

At that, the operation of the moving parts of the manipulator in the welding zone may be complicated by the 
influence of the heat generated. This problem is partially solved by the use of water cooling of burners with autonomous 
cooling devices. To completely eliminate this problem, you will need to additionally solve another task. Namely, a 
thermal problem with the simulation of a thermal process to determine and compensate for thermal expansion caused by 
heating by electric discharge or electric arc [8]. 

Research Results. To develop a control program for a robot that operates in an angular coordinate 
system (Fig. 1), it is required to calculate the angular coordinates of the movement of the end-effector of the 


manipulator (gripper) [1-4, 6, 7]. Figure 2 shows its scheme, consisting of two rods | and 2, which are connected by a 


' Kozyrev YuG. Promyshlennye roboty: osnovnye tipy i tekhnicheskie kharakteristiki. Moscow: KNORUS; 2015. 560 p. (in Russ.) 
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ball-and-socket joint 3 and a flat joint 4. The whole structure is installed on the base 5. The manipulator rods have 
lengths lL, and [,. Joint 3 can rotate in the horizontal plane (angle a) and in the vertical plane (angle B). Joint 4 rotates in 


a vertical plane (angle y). 


a) 
Fig. 2. Design of a two-link articulated manipulator: a — main view; b — top view (the author's figure) 
Figure 3 shows a diagram of a two-link articulated manipulator in the form of a hemisphere with radius R = l, + I, 


and with a cut-out hemisphere with radius r, which is determined empirically when debugging the manipulator. 


aa 
O 


Fig. 3. Diagram of a two-link articulated manipulator (the author's figure) 
The manipulator control system should set the position of the tool in the angular coordinate system and, for the 
convenience of the user, convert it into the parameters of the Cartesian coordinate system. 


We take the base of the structure (point O) as the Cartesian coordinate system origin and arrange its axes as shown 
in Figure 4. 


Zi 


o 1 al 
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Fig. 4. Rectangular coordinate system centered at point O (the author's figure) 


Angle a of the projection of the segment OB on plane XOY is shown in Figure 5. 
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Fig. 5. Determination of the projection angle of segment OB on plane XOY (the author's figure) 


Angle a is determined from the formula: 


x 
a = tarccos 


x2 Fy? 
where x and y — coordinates of point B. 
The sign “+” should be put if y is greater than or equal to zero, and the sign 


Tas 


, when y is less than zero. 
Angles of plane ZOB ,, 8, and y between the coordinate axes and levers l, and l, are shown in Figure 6. 
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Fig. 6. Determination of angles 6,, Bz and y (the author's figure) 
We find formulas for determining angles 6,, 6, and y using the cosine theorem: 
P+z*+x%?+y?-B 


2-l-Vz7+x2+y? ; 
Zz 
Bo =arcsin —_— : 
fz27+x24+ y? 


B, = arccos | 


eo — 7% — x? — 

y = arccos F 
2-l +l, 

where x, y and z — coordinates of point B. 

The ratios obtained can be used to calculate angular coordinates when developing control programs for a two-link 
manipulator of an industrial robot, solving problems of positioning or contouring control using feedback sensors for 
continuous monitoring and correction of intermediate points of the manipulator trajectory’ and drive motor control [5, 6]. 

Dynamic systems of robots, including two-link manipulators operating in an angular coordinate system, are 
characterized by nonlinearities and are subject to disturbances. Therefore, to eliminate errors when reproducing the 


movement trajectory of the manipulator end-effector, the proposed calculation of angular coordinates can be 


supplemented with solutions using the following methods: 


> Glushko SP, Chastikov AP, Kornienko VG, et al. Software System for Testing and Debugging Control Programs for a Robotic Complex. Certificate 
of Software State Registration No. 2011611987, 2011. (In Russ,) 
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— neural network modeling [9]; 

— simulation study of the robotic arm system for fault detection and evaluation [10]; 

— equivalent principle of variable sliding mode structure for accurate recovery of arbitrary nonlinear faults [11]; 

— genetic algorithm for solving the trajectory planning problem [12]; 

— joint trajectory generation for robotic arms with collision avoidance capability [13]. 

To control a two-link articulated manipulator with complex trajectories of its movement, it is promising to use the 
adaptive control with feedback sensors. Its signals are processed, and, based on the results of processing, decisions on 
further actions are made. 

The structure of the proposed control system hardware (Fig. 7) includes drives of the manipulator links, sensors of 
the angular position of the manipulator links, temperature sensors of the burner mounting unit, a programmable logic 
controller that performs manipulator control functions. 

Industrial robots use electric, hydraulic and pneumatic drives with translational and rotational motion. An electric 
drive, which is distinguished by a wide range of engine capacities, ease of speed control, and ease of automating control 


processes, is the most widespread in robotics. 


Manipulator 


t——; Sensor 


| 
| a 
| 
ee | Drive 
_ — I 
i 
oD Ht Sensor 
re | 
r= | 
So Feo*£, Drive 
© 
| Sena — | 
CO 
ts+—| Sensor 


| 
I i; -aaees 1 
rt7=| Drive 


Fig. 7. Structure of hardware of the multilink articulated manipulator control system (the author's figure) 

To control angular movements in multilink articulated mechanisms of manipulators with adaptive control systems 
performing complex trajectories, it is recommended to use angular position sensors — encoders. They provide 
measuring the movement parameters of the tool or the object being processed, the angles of their rotation, the direction 
of movement, the rotation speed of the shaft of the electric motor or gearbox, the angular position in relation to the zero 
mark, the direction of rotation. 

Incremental and absolute encoders can be used in adaptive control systems. Incremental encoders are characterized 
by simplicity, reliability, and relatively low cost. Absolute encoders are more complicated and more expensive, but they 
provide determining the rotation angles of the axes of the links at any time immediately after turning on the power, and 
even in the stationary state of the links. Absolute encoders also enable to determine the rotation angles of the axes of the 
links when disconnecting and then restoring power, and do not require the device to return to its initial position. 
Moreover, the signals of absolute encoders are not affected by interference and vibration. In recent developments of 
adaptive control systems, inertial sensors with a number of improvements to compensate for errors in the manipulator 


movement control system have appeared [14]. 
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Discussion and Conclusions. The calculation of angular coordinates for programming the operation of the control 
system of a two-link manipulator performing in an angular coordinate system and moving the working body along a 
complex trajectory was carried out. The relations of angular and Cartesian coordinates obtained in the work can be used 
to calculate and control angular displacements and to program control systems for two-link manipulators of industrial 
robots that move end-effectors along complex trajectories. 

The calculation of angular coordinates for controlling a two-link manipulator of an industrial robot is presented in 
this paper as a solution to a geometric positioning problem. It can be used when modeling a similar manipulation device 
or when building a control system for such a manipulator and organizing the exchange of information between the user 
and the control system. It is also designed to check the accuracy and debug the movement of the end-effector of an 
industrial robot using feedback. 
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